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Abstract 

An attitude control strategy for maneuvers of an interconnection of planar bodies in 
space is developed. It is assumed that there are no exogeneous torques and that torques 
generated by joint motors are used as means of control so that the total angular momen- 
tum of the multibody system is a constant, assumed to be zero in this paper. The control 
strategy utilizes the nonintegrability of the expression for the angular momentum. Large 
angle maneuvers can be designed to achieve an arbitrary reorientation of the multibody 
system with respect to an inertial frame. The theoretical background for carrying out 
the required maneuvers is summarized. 



1. Introduction 


In this paper we develop an attitude control strategy for a system of N planar 
rigid bodies in space which are interconnected by ideal frictionless pin joints in 
the form of an open kinematic chain. Angular momentum preserving controls, e.g. 
torques generated by joint motors, are considered. The iV-body system is assumed 
to have zero initial angular momentum. Our earlier work 1 ' 2 demonstrated that re- 
orientation of a planar multibody system with three or more interconnected bodies 
using only joint torque inputs is an inherently nonlinear control problem which is 
not amenable to classical methods of nonlinear control. The goal of this study 
is to indicate how control strategies can be explicitly constructed to achieve the 
desired absolute reorientation of the iV-body system. The key is to excite certain 
oscillatory motions in the shape of the structure, thereby providing a capability 
for reorientation of the structure with respect to an inertial frame. 

There are many physical advantages in using internal controls, e.g. joint torque 
controls, to carry out the desired muitibody reorientation maneuvers. First of all, 
this control approach does not modify the total angular momentum of the multi- 
body system. In addition, internal controls have obvious advantages in terms of 
energy conservation. Moreover, they can be implemented using standard electrical 
servo motors, a simple and reliable control actuator technology. 

The formal development in this paper is concerned with control of a multibody 
interconnection in space which has zero angular momentum. Although these re- 
sults are formulated in a general setting, we have been motivated by several classes 
of specific problems. Several potential applications of our general results are now 
described. 

Manipulators mounted on space vehicles and space robots have been envisioned 
to carry out construction, maintenance and repair tasks in an external space en- 
vironment. Previous research on maneuvering of such space multibody systems 
has mainly focused on maneuvers which achieve desired orientation of some of the 



bodies, e.g. an end effector, while the orientation of some of the remaining bodies 
cannot be specified, at least using the methodologies employed 3-8 . Another related 
application is the performance by astronauts of reorientation maneuvers in space. 
Previous research in this area 2 * * * * * * 9 has emphasized dynamics issues. Closely related 
research has focused on describing the reorientation maneuvers of a falling cat 10 . 
Finally, we mention another area of potential application of the results of this 
paper, namely the development of deployment maneuvers for multibody antennas 
connected to a spacecraft. It is expected that such an approach would have many 
advantages over the use of existing passive antenna deployment mechanisms 11 . 

This paper is organized as follows. In Section 2, a mathematical model for a 
planar multibody system in space is derived. We then formulate an attitude control 
problem associated with the planar multibody system. In Section 3, we first sum- 
marize several relevant theoretical results. We then introduce an attitude control 
strategy to solve this reorientation problem. Section 4 consists of a summary of the 
main results and concluding remarks about our continuing research. Although a 
complete treatment of the topics in the paper requires use of differential geometric 
tools, our presentation avoids these tools and uses only elementary mathematical 
methods. However, references to relevant literature are provided throughout. 


2. Mathematical Model for Planar Multibody System 

We consider a system of N planar rigid bodies interconnected by frictionless 

one degree of freedom joints in the form of an open kinematic chain. The configu- 

ration space, for an observer at the center of mass of the system of rigid bodies, is 

N dimensional. Since we assume an open kinematic chain there are exactly IV — 1 
joints. We consider controlling the rotational motion of the system using torques 

at the joints; each joint is assumed to be actuated so as to permit free adjusment 

of the joint angle. It is assumed that there are no external torques acting on the 

system. It is clear that the configuration of the N bodies can be described by the 

absolute angle of any one of the bodies (say body 1) and N — l joint angles. Denote 

by 9i the absolute angle of body 1, and by the (N — l)-vector ip = (i/q, • • • , V'N-i) 


the joint angle vector. Clearly, (9 x ,ip) is a generalized coordinate vector for the 
rotational motion. It can be shown that the Lagrangian (which is equal to the 
rotational kinetic energy under the above assumptions), written in terms of these 
coordinates and their time derivatives, does not contain 9 X explicitly, i.e. 9 X is a 
cyclic or ignorable coordinate. Consequently, the generalized momentum associ- 
ated with the cyclic coordinate 9 X is conserved. This conserved quantity is the first 
integral of the motion corresponding to conservation of angular momentum of the 
system. In this paper we assume zero initial angular momentum so that angular 
momentum remains zero throughout a maneuver. 

It is clear that Lagrange’s equations describe the motion on the joint angle 
space, and the evolution of 9 X can be obtained from the expression for conservation 
of angular momentum. Thus, the motion of a planar multibody system, under the 
above assumptions, can be described by the following reduced order equations 


*W)0 + F s (lp,Xp) = T , 

(1) 

6i + s'(xp)ip = 0 

(2) 


where r = (rj, • • • ,r^_x) denotes the ( N — l)-vector of joint torques, J 3 (xp) is a 
symmetric positive definite (N — 1) x (N — 1) matrix function; and s(ip), F s (tp,ip) 
are ( N — l)-vector functions. Note that in this paper a “prime” denotes tranpose. 
The explicit specifications of these functions can be found in the literature 1,2,12 . 

State space equations for (1) and (2) are 
0\ - -s(xp)'u , 


•0 = W , 

( 4 ) 

u = -j;\xP)F s (xP,u) + j; 1 (xP)t . 

( 5 ) 


( 3 ) 


Note that equations (4), (5) are expressed in terms of the joint phase variables 
(ip, xp) only. Hence the joint angle space constitutes a reduced configuration space 



for the system. This reduced configuration space is also referred to as the “shape 
space” of the system 12-16 . It is possible to consider control problems expressed 
solely in terms of the shape space; such problems can be solved using classical 
methods. However, in our work we are interested in the more general control 
problems associated with the complete dynamics of the multibody system defined 
by equations (l)-(2) (or (3)-(5)). 


Note that equations (4) : (5) only, which represent the projection of the motion 
onto the shape phase space, are feedback linearizable using the feedback transfor- 
mation 


u = -J, 1 (0)^(0,w) + J s l {i >) t 


( 6 ) 


where u € R N 1 ■ The above feedback transformation yields the following normal 
form equations 


01 = , 

(7) 

V’ = W , 

(8) 

<jj = u . 

(9) 


We remark here that it is impossible to completely linearize the system defined by 
equations (3)-(5) using static or dynamic feedback combined with any coordinate 
transformation. 


Note that an equilibrium solution of equations (3)-(5) corresponding to r = 0 
(or equivalently an equilibrium solution of equations (7)-(9) for u — 0) is given by 
(0j, xjs e , 0), where (0l,ip e ) is referred to as an equilibrium configuration. Hence 
an equilibrium solution corresponds to a trivial motion of the system for which all 
the configuration space variables remain constant. 

Note also that equation (3) represents conservation of angular momentum. This 
equation is not integrable for N > 3 (i.e. if the multibody system consists of three 



or more links). This fact has important implications in terms of controllability 
properties of the system as will be shown in the subsequent development. As a 
consequence of the symmetry possessed by the system, 9i does not appear explicitly 
in equation (3). Mechanical systems with such symmetry properties are referred 
to as Caplygin systems 17-21 . As a consequence of the nonintegrability for N > 3, 
the scalar analytic functions 


TT t.,\ ds,(V>) dSjty) ,^.,2 

= — ^r— - (m) € I , 




dipi 


( 10 ) 


where / = { 1 , - - • , iV — 1}, do not all vanish, except possibly on a set which has 
measure zero with respect to the shape space. 


3. Attitude Control Problem 

In this section, we address the following control problem associated with planar 
multibody, systems described by equations (l)-(2) : 

Problem : Given an initial state (9® , , ui°) and a desired equilibrium so- 

lution (9l,fi e ,0), determine a motion (9i(t),rp(t),uj(t)), 0 < t < tf, such 
that (9 l (0)M0)M0)) = (0?,0°,a; 0 ), (0i(t,),tf(</M*/)) = (^,0) and 
(9i(t),x()(t),uj(t)) satisfies equations (l)-(2) for some control function t \ — » r(t). 

Note that, in particular, if u; 0 = 0 then. the above problem corresponds to a 
rest-to-rest maneuver. 

The existence of solutions to the above control problem was demonstrated in 
our earlier work 1,2 . In particular, we studied the nonlinear control system described 
by equations (7)-(9) and employed certain results from nonlinear control theory 
to characterize controllability properties of planar multibody systems described 
by equations (l)-(2). These results not only prove the existence of solutions of 
the above problem but they also provide a theoretical basis for construction of 
nonlinear control strategies required to achieve the desired maneuver. We next 



summarize those results 1 ' 2 . 


Under the stated assumptions, a planar multibody system has the following 
properties if N > 3, i.e. if it consists of three or more links: 

1. The system is strongly accessible. 

2. The system is small time locally controllable from any equilibrium. 

3. The system can be transferred from any initial condition to any desired 
equilibrium in arbitrarily small time. 

If N = \ or N = 2, then the system is not even accessible, not small time 
locally controllable and there exist initial conditions which cannot be transferred to 
a desired equilibrium. 

The proofs 1,19 of the first two results depend on showing that certain Lie alge- 
braic conditions are satisfied if iV >3. The third result is proved 1,19 constructively. 

It should be emphasized that the subsequent development is assumed to be 
carried out for multibody systems consisting of three or more links ( N > 3) Note 
that the reorientation or attitude control problem generally has many solutions. 
In this paper, we describe one solution approach, outline the theory behind it, and 
present some data from simulations. The key observation is that there is nonlinear 
coupling between changes in the shape of the structure and the rotational motion 
of the structure as a whole; this coupling is used to achieve reorientation of the 
structure. 

Consider equation (3). Assume that joint angles are controlled in such a way 
that ip(t), 0 < t\ < t < t 2 , describes a closed path 7 in the shape space. Integrating 
both sides of equation (3) from t = t\ to t = <2 and using the fact that dip = zfdt, 
we obtain 

Oi{t 2 ) -diiU) = j> s'^dxf . (11) 

Thus by proper selection of a path 7 in shape space, any desired geometric phase 



(which is a rotation of link 1) can be obtained. By the nonintegrability property 
mentioned previously, the above integral is in fact path dependent thereby guar- 
anteeing the existence of (many) such paths. 

Note that in differential geometry the quantity 

a(7) = ® s'(0)dV> 

J~t 

is referred to as the geometric phase (or holonomy) of the closed path 7. This 
quantity depends only on the geometry of the closed path and is independent of 
the speed at which the path is traversed. 

Note that Stokes’ formula can be applied to obtain an equivalent formula for 
0(7) as a surface integral. For simplicity, assume that N — 3, i.e. the shape space 
is the (V>i,V>2) plane. Also, let 7 be traversed counterclockwise. Then by Stokes’ 
theorem the above formula can be written as 

. a(7) = L [ ^k ~ 

where S is the surface within the boundary 7. In the case that the path is traversed 
clockwise, the surface integral is equal to —0(7). 

More information concerning geometric phases can be found in the literature 15 . 
Geometric phase ideas have proved useful in a variety of inherently nonlinear con- 
trol problems 19-21 . These ideas have also been used for a class of path planning 
problems based solely on kinematic relations 13,14,16 . 

We now describe a control strategy, using the above geometric phase relation 
(11), which solves the reorientation problem. 

Let (#j,^> e ,0) denote the desired equilibrium solution. We refer to (#',V* e ) and 
t/> e as the desired equilibrium configuration and the desired equilibrium shape, re- 
spectively. We describe four steps involved in construction of an open loop control 
function U[o,t f ) = (ui, • • • , ujv-i)' which transfers any initial state (0i,0°,u; 0 ) to 



(0',t/> e ,O) in time exactly tj, where tj > 0 is arbitrary. 

Let 0 < ti < t 2 < t 3 < tf denote an arbitrary partition of the time interval 
[ 0 , tf). 

Step 1 : Transfer the system to the desired equilibrium shape, i.e. find a control 
which transfers the initial state (9° , xf°, u>°) to 0) at time t\, for some 9\. 


Since the dynamics on the shape phase space are so simple, namely decoupled 
double integrators, Step 1 has many solutions which are easily obtained using 
classical methods. One such control function is 




t £ [0, 0.5ti ) 
t € [0.5tj, tj) . 


( 12 ) 


Next, we select a closed path 7 (or a series of closed paths - see Remark 1 below) 
in the shape space which achieves the desired geometric phase. There are many 
ways to accomplish such a construction; in our work we have found it convenient 
to use only two joint motions, keeping the other joints locked, and to use a square 
path in the restricted two dimensional shape space. It is convenient to select the 
center of the square path in a region of the shape space which corresponds to a 
“large” geometric phase change (see Remark 2 below). 


To make the above ideas more concrete, we present a specific construction. Let 
(i,j) € / 2 , i 7 ^ j, denote a pair of joints. Assume that for t > t x only this pair of 
joints are actuated while all the other joints are kept fixed. This is equivalent to 
locking all the joints except the ones labelled i and j and treating the N bodies as 
three interconnected bodies, for t > t x . In this case the desired geometric phase 
formula can be written as 

~ e \ = +<*(7) 

where +(-) corresponds to counterclockwise (clockwise) traversal of the closed path 
7. Since we desire to make 9 x {tj) = 9\, the closed path 7 should be selected to 



satisfy 

*;-*! = ±<*( 7 ). 

The path 7 lies in the two dimensional (ipi, i/>_, ) plane, so that 

0(7) = jf + 

where the scalar functions d’j) and §j(ipi,ipj) are obtained by evaluating 5,(0) 

and Sj(?/>) at ipk = i>l-> Vfc € / where A: ^ i,j. 

As mentioned above we choose 7 to be a square path in the (ipi,ipj) plane which 
is centered at the shape defined by and which has side of length z*, where 2* 
satisfies 

±c*(7z*) + 0\ — G\ — 0 . 

Here y z indicates the dependence of the square path on the size parameter 2. In 
most cases, this equation is easily solved using standard numerical procedures. 

Remark 1 : Note that here, for notational simplicity in presenting the main idea, 
we assume that the desired geometric phase can be obtained by a single closed 
path. In general, more than one closed path may be required to produce the 
desired geometric phase; for such cases 7 can be viewed as a concatenation of a 
series of closed paths. In any event, the motion along such a closed path defines a 
periodic motion corresponding to a change in the shape of the structure. 

Remark 2 : Selection of the center point ip* of the path is rather arbitrary, e.g. 
one selection is ip* = ip e . However, other choices may provide a greater change 
in the geometric phase for a given size path. In this regard, the use of Stoke’s 
theorem, as indicated previously, suggests that ip* should be chosen where 

, dsj(ip) dsj(ip) 
dipt dipj 

is a maximum. 



We now describe the remaining three steps as follows. 


Step 2 : Transfer the system from state (8\,if e , 0) to a state corresponding to the 
comer of 7 closest to i[) e , along an arbitrary path in the shape space, in t 2 — t\ 
units of time. 


As an example, if p\ is the corner of 7 closest to we propose the following 
control function for Step 2. 


2;r(p* - 0 e ) . 2 njt - tj) 

U[tUt2) (<2-tl) 2 Sm( (<2-tl) ) ' 


(13) 


Step 3 : Traverse the selected square path (counterclockwise or clockwise, depend- 
ing on the sign of the desired geometric phase value), in t$ — t 2 units of time; the 
resulting change in the angle is necessarily 9\ — 0\. 


Without loss of generality, we assume that the desired geometric phase value 
is obtained by counterclockwise traversal of the closed path starting and ending at 
p*. Then, the following control functions guarantee traversal of the closed path, 
thereby accomplishing Step 3. 


~P\) „ : _,27r(*-f 2 ) N 

(14) 

MP3-P2) • ,27 *{t-t 2 -h) s 

u [h+h,t 2 +2h) - ^2 Sin( h ' 

(15) 

2?t(P4 — P3) 2ir(t ~t 2 — 2h) ^ 

U[t 2 +2/»,tj+3A) ^2 S1I H /j / ’ 

(16) 

2tt(p* — p\) 2ir(t — t 2 — 3h) N 

u [h+3h,ti) h 2 Ljin ^ fi ) 

(17) 


where h = (t 3 — t 2 ) / 4. 

Step 4 : Transfer the system back to the desired equilibrium shape 0 e following the 
path used in Step 2, in tj — 1 3 units of time; thereby guaranteeing that the desired 
final state , ■ 0 e , 0 ) is reached at time tj. 



The following control function 


U [t3,tf) 


2n(ijj e — pi) . ,2tt (t-t 3 ) 


accomplishes Step 4. 


( 18 ) 


The corresponding control torque r can be computed using equation (6). It is 
clear that the constructed control torque transfers the initial condition of the sys- 
tem (l)-(2) to the desired equilibrium configuration at time tj. It is important to 
emphasize that the above construction is based on a priori selection of a square as 
the closed path in the shape space. Selection of square paths simplifies computa- 
tion of the controls; however other path selections, e.g. corresponding to sinusoidal 
changes in the shape of the structure, could be made. There are infinitely many 
choices for control functions which accomplish the above four steps, and the total 
time required is arbitrary. 


4. Conclusions 


In this paper we have developed an attitude control strategy for planar rigid 
bodies interconnected by ideal pin joints in the form of an open kinematic chain. 
The control strategy utilizes the nonintegrability of the expression for angular mo- 
mentum. We have demonstrated that large angle maneuvers can be designed to 
achieve an arbitrary reorientation of the multibody system with respect to an iner- 
tial frame; the maneuvers are performed using internal controls, e.g. servo torque 
motors located at the joints of the body segments. The theoretical background 
for carrying out the required maneuvers has been briefly summarized. We men- 
tion two nontrivial extensions of the approach in this paper which are currently 
being developed. The first extension is to non-planar reorientation maneuvers of 
multibody systems consisting of rigid and flexible links; in this case the dynamics 
issues are much more complicated but in principle the approach is viable 22 . An- 
other extension is the development of feedback implementations of the controls 
presented in this paper; some results have been obtained 19 using a (necessarily) 



discontinuous feedback strategy. These important extensions generally require the 
use of differential geometric methods for a complete treatment. 
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